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Abstract 

This work proposes a control law for a manipulator with the aim of realizing desired time-varying motion-force profiles in 
the presence of a stiff environment. In many cases, the interaction with the environment affects only one degree of freedom 
of the end-effector of the manipulator. Therefore, the focus is on this contact degree of freedom, and a switching position- 
force controller is proposed to perform the hybrid position-force tracking task. Sufficient conditions are presented to guarantee 
input-to-state stability of the switching closed-loop system with respect to perturbations related to the time-varying desired 
motion-force profile. The switching occurs when the manipulator makes or breaks contact with the environment. The analysis 
shows that to guarantee closed-loop stability while tracking arbitrary time-varying motion-force profiles, the controller should 
implement a considerable (and often unrealistic) amount of damping, resulting in inferior tracking performance. Therefore, 
we propose to redesign the manipulator with a compliant wrist. Guidelines are provided for the design of the compliant wrist 
while employing the designed switching control strategy, such that stable tracking of a motion-force reference trajectory can be 
achieved and bouncing of the manipulator while making contact with the stiff environment can be avoided. Finally, numerical 
simulations are presented to illustrate the effectiveness of the approach. 
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1 Introduction 

Numerous applications such as, e.g., bilateral teleop¬ 
eration, automated assembly tasks, and surface finish¬ 
ing involve the interaction between a robot manipulator 
and a stiff environment. In those applications, the sta¬ 
bility of transitions from free motion to constrained mo¬ 
tion and from constrained motion to free motion is es¬ 
sential for accomplishing the desired task. Ensuring sta¬ 
bility during these transitions is a challenge as the com¬ 
bined robot-environment dynamics switches abruptly at 
the moment of contact and detachment from the envi¬ 
ronment. 

Different control architectures have been proposed for 
motion-force control of a manipulator in contact (for 
an overview, see, e.g., [1, Chapter 7]), but the stabil¬ 
ity question is still open. The most studied and applied 
control schemes include stiffness, impedance and admit¬ 
tance control [2,3,4,5,6,7], hybrid position-force control 
[8,9], and parallel position-force control [10]. The gains 
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in these control schemes are tuned separately for free mo¬ 
tion and constrained motion. Stability of the resulting 
closed-loop dynamics is analyzed using standard Lya¬ 
punov methods and guaranteed for free motion and con¬ 
strained motion, but the contact and detachment transi¬ 
tions are not included in the analysis. Bouncing and un¬ 
stable contact behavior might therefore still occur, and 
do still occur. As a practical solution, when implement¬ 
ing these control schemes on a physical manipulator, the 
manipulator is usually commanded to approach the en¬ 
vironment with a very slow velocity to prevent the exci¬ 
tation of the unstable contact dynamics. 

The aim of this paper is to go beyond the current state 
of the art and propose a novel stability analysis for this 
problem. We propose a mathematical analysis that can 
help control engineers as well as mechanical designers 
to develop controlled manipulators that exhibit stable 
contact behavior with a stiff environment. We propose 
a controller and a stability analysis to verify if stabil¬ 
ity is guaranteed even during contact and detachment 
phases. A key aspect is that we are interested in track¬ 
ing time-varying motion and force profiles. This specific 
goal originates from our interest in telerobotics, where a 
force and position reference from the master device has 
to be translated into a command for the slave device. 





As the force and position reference comes from a human 
operator, we want to allow those reference signals to be 
as general as possible. 

Few theoretical studies have addressed directly the 
root cause of the instability during bouncing against a 
stiff environment. In [11,12], a switched position-force 
controller is considered, where the controller switches 
from motion to force control when contact with the envi¬ 
ronment is made. Using analysis techniques for switched 
systems, conditions for asymptotic stability are derived 
for a constant position or force setpoint regulation prob¬ 
lem. Hysteresis switching is considered in [13] to prevent 
bouncing of the manipulator against the environment. 
In [6], a switching rule is designed for the impedance pa¬ 
rameters to dissipate the kinetic energy engaged at im¬ 
pact. The resulting “active impedance control” guaran¬ 
tees “velocity regulation in free motion, impact attenu¬ 
ation” and tracking of a constant force setpoint in con¬ 
tact. The number of bounces is cleverly minimized in 
[14] by exploiting a transition controller, but then the 
contact force is controlled to a constant setpoint. In [15], 
nonlinear damping is proposed to minimize the force 
overshoot without compromising the settling time. In all 
these publications, tracking of desired time-varying mo¬ 
tion and force profiles is not considered. 

In the above mentioned papers, the manipulator- 
environment interaction is modeled using a flexible 
spring-damper contact model. The stiffness and damp¬ 
ing properties of the environment are included explicitly 
and, as a consequence, the impact phase has a finite 
time duration. Such a modeling approach is also taken 
in this paper. 

Manipulator-environment interaction can also be 
modeled using tools from nonsmooth mechanics [16,17]. 
In doing so, the time duration of the impact event is as¬ 
sumed to be zero and an impact law (e.g., Newton’s law 
of restitution) is employed to characterize the collision. 
Stable tracking of specific force/position profiles using 
such nonsmooth mechanics modeling formalism has 
been addressed in this context. In [18], a discontinuous 
control scheme is proposed to ensure stable regulation 
on the surface of the unilateral constraint. A switched 
motion-force tracking controller for manipulators sub¬ 
ject to unilateral constraints is considered in [19,20,21]. 
There, it is shown that the design of the desired tra¬ 
jectory in the transition phase is crucial for achieving 
stability. 

To the best of authors’ knowledge, the problem of sta¬ 
ble tracking of arbitrary force/position profiles as we 
consider in this work has not been solved even in the 
framework of nonsmooth mechanics. The stability of the 
tracking controller cast in this framework is clearly of 
interest and deserves further investigation. This frame¬ 
work will not be addressed here just because, as we 
mentioned, we adopt a flexible (spring-damper) contact 
model. 

In this work, we propose a control law for making 
a manipulator track a time-varying motion and force 


profile. Because in many tasks of practical interest the 
interaction of the robot end-effector with the environ¬ 
ment occurs just in one direction, we study the con¬ 
tact stability problem using a 1-DOF dynamic manip¬ 
ulator model. The remaining unconstrained DOFs can 
be controlled with standard motion control techniques 
(see [22]). We propose a switched motion-force tracking 
control strategy and include the transitions from free 
motion to contact (and vice versa) in the stability anal¬ 
ysis of the closed-loop dynamics. The obtained stability 
conditions are given in Theorem 1 in Section 3. The sta¬ 
bility analysis of the closed-loop system reveals that the 
controller should implement a considerable amount of 
damping to guarantee stability while tracking an arbi¬ 
trary time-varying motion-force profile. Because an ex¬ 
cessive amount of damping limits the tracking perfor¬ 
mance due to a sluggish response, we propose an alterna¬ 
tive mechanical manipulator design by including a com¬ 
pliant wrist. In this way, the resonance frequency of the 
impact and contact transients can be reduced and the 
associated energy can be dissipated in a passive way. The 
use of such an “energy absorbing component” is men¬ 
tioned in [3], but a stability analysis is not considered 
therein. 

The main contributions of this paper are as follows. 
First, we propose a combination of the compliant wrist 
design with a novel switched motion-force controller for 
the tracking of time-varying motion and force profiles. 
Secondly, we propose a stability analysis that provides 
design guidelines for both the compliant wrist and con¬ 
troller to guarantee stable contact while tracking arbi¬ 
trary motion and force profiles. In particular, we show 
how bouncing of the manipulator against the stiff envi¬ 
ronment can be prevented without the need of a consid¬ 
erable amount of damping from the controller. 

This article is organized as follows. In Section 2, the 
manipulator and environment model are introduced and 
the controller design is proposed. The stability analysis 
is described in Section 3. Section 4 illustrates the ob¬ 
tained results by means of a simulation study. Section 5 
discusses the benefits of additional (wrist-)compliance 
in the manipulator and the conclusions are presented in 
Section 6. 

2 System modeling and controller design 

Our primary goal is to design a controller for mak¬ 
ing a manipulator track a desired motion-force profile. 
As explained in the introduction, we focus on a 1-DOF 
modeling of the manipulator-environment interaction. 

Consider the decoupled contact DOF of the manipu¬ 
lator as depicted in Figure 1. The Cartesian space dy¬ 
namics are described by 

M x + bx = F c — F e , (1) 

where x represents the manipulator position, M > 0 the 
equivalent mass of the manipulator, b > 0 the viscous 
friction in the joint, F c the control force and F e the force 
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Figure 1. 1-DOF manipulator. 

exchanged between the environment and the manipu¬ 
lator. The environment is modeled as a static wall at 
x = 0 and, without loss of generality, the manipulator is 
in contact with the environment for x > 0. In [11,12], the 
environment is modeled as a piecewise linear spring. We 
consider, similarly to [13], an extended model including 
damping and friction. Namely, we use the Kelvin-Voigt 
contact model 


F e (x,x) 


0 for x < 0 

k e x + b e x for x > 0 


( 2 ) 


with k e > 0 and b e > 0 the stiffness and damping prop¬ 
erties of the environment, respectively. This model is 
nonlinear and non-smooth due to the abrupt change in 
F e at x = 0. 

In free motion, the manipulator is required to follow 
a bounded desired motion profile x d (t), whereas in con¬ 
tact, a desired force profile F d (t) should be applied to the 
environment. Impedance controllers have been proposed 
in, e.g., [4,5] to control the contact force F e by creating 
a force loop around an inner motion control loop. In this 
way, a desired impedance of the contact is designed, but 
the contact force is controlled indirectly. We propose, 
instead, the following switched motion-force controller 
that switches between a resolved acceleration controller 
in free motion and a force controller in the contact phase: 

(M a x d (t) + k d (x d (t ) — x) + k p (x d {t) - x), Vx < 0,(3a) 

fA 

\ F d {t) + kf(F d (t) - F e ) - b f x, Vx > 0,(3b) 

such that both motion and force are controlled directly. 
Here, k p > 0 and k d > 0 are the proportional and deriva¬ 
tive gains of the motion controller, respectively. The es¬ 
timated mass of the manipulator M a > 0 in (3a) might 
differ from the actual mass M in (1) due to uncertainties 
in the model parameter identification. The gain kf > 0 
represents the proportional term of the force controller 
and bf > 0 is the damping gain, dissipating energy dur¬ 
ing the contact phase. For the controller (3), it is as¬ 
sumed that the contact force F e , position x and velocity 
x can be measured. Although, in (3), the switching be¬ 
tween motion control and force control is decided based 
on the actual position x of the manipulator, for a stiff 
environment, k e b e , this is equivalent to switching 
based on the interaction force F e . This implies that a 
perfect knowledge of the location of the environment is 
not necessary for the implementation of the controller 
defined by (3). 


In order to analyze stability of the system described 
by (l)-(3), we reformulate the closed-loop dynamics as a 
switching state-space model. A key idea for the stability 
analysis, detailed in Section 3, is to express the force 
tracking error F d (t) — F e in terms of the motion tracking 
error Xd(t) — x, such that both in free motion and in 
contact the goal is to make the tracking error x d (t) — 
x small. In contact, x d (t) then represents the ’virtual’ 
desired trajectory, corresponding to the desired contact 
force F d (t). For the relationship between F d (t) and x d (t) 
during contact, x x d {t) should also imply F e F d (t). 
To this end, we consider the following relationship to 
deduce x d (t) from F d (t) in the contact phase: 

k e x d {t) + b e x d (t) = F d (t), for F d {t) > 0, (4) 

where k e and b e are available estimates of k e and b e . 
Assumption 1 The desired position x d (t) and velocity 
x d (t) trajectories are continuous, and the desired accel¬ 
eration x d (t) is piecewise-continuous and bounded. 

Two separate user-defined motion and force profiles 
can be glued together to satisfy Assumption 1 by using 
the design procedure detailed in Appendix A. 

In terms of the exact parameters k e and b e , (4) can be 
rewritten as 

k e x d (t) + b e x d {t) + Wf(t) = F d (t), for F d (t) > 0, (5) 

with «;/(£) := (k e — k e )x d (t) + (b e — b e )x d {t) a bounded - 
due to Assumption 1- perturbation. When the estimates 
k e and b e are exact, Wf(t) = 0 and x — x d (t) —> 0 im¬ 
plies that F e — F d (t) —> 0. When k e ^ k e and/or b e ^b e , 
Wf(t)^0 and acts a perturbation in the stability anal¬ 
ysis. Since the mapping (5) is only used for the stability 
analysis and not in the controller (3), the lack of exact 
knowledge of k e and b e will not affect the stability or 
tracking of the system described by (l)-(3). 

The tracking error 


Zi 


X d {t) - X 

_ z 2 _ 


X d {t) - X 


can be used to rewrite the closed-loop system dynam¬ 
ics (l)-(3) and (5) as the following perturbed switched 
system 


X7: z = AiZ + Nwiit) = 


0 1 

—Ki -B t 
z e e {1,2}, 


where N = [0, 1] and 
ts . A d_ k d + b 

Kl m’ Bl -^r> 


z + Nwi(t ), 

( 7 ) 

(8a) 


is . (1 + kf)h e n . (! + kf)b e + bf + b 

l<2 - M ’ B2 -- M -’ (8b) 
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m ft) := 

M - M 

M 

~Mt)+ M 

Xdft), 

(8c) 

w 2 {t) := 

= Xdft) + 

b f + b. 

M Xd{t) 


(8d) 

with Wf 

as in (5). 

The perturbations Wift), i 

= {1,2}, 


are bounded due to Assumption 1. All system param¬ 
eters are positive, implying that in (7), for i £ {1,2}, 
Ki,Bi > 0 and A, is Hurwitz. The environment is lo¬ 
cated at x = 0, so switching occurs at x = Xdft) — z\ = 0. 
Expressed in the z-coordinates, the free motion and con¬ 
tact subspaces, respectively denoted by Hi and H 2 , are 
time-varying: Hi(t) := {z £ R 2 |£d(£) — z\ <0} and 
H 2 ft) '■= {z £ R 2 |£d(t) — zi > 0}. Note that for all t, 
fli(t) U U 2 (t) = R 2 and Hi(t) D O 2 (t) = 0. 

The environment stiffness k e is typically much higher 
than the control gain k p . Furthermore, the true value of 
k e and b e are usually unknown and therefore the control 
parameters cannot be selected to result in K\ = K 2 and 
B\ = B 2 in (7). Thus, in general, £ p in (7) represents 
a switched system. The stability of £ p does not follow 
from the stability of each of the two continuous subsys¬ 
tems (corresponding to free motion and contact) taken 
separately, as shown, e.g., in [8,10] (see also [23] in the 
scope of generic switched systems). Hence, the switching 
between the two subsystems, corresponding to making 
and breaking contact, must also be taken into account. 
This is the purpose of the next section. 

3 Stability analysis 

In this section, sufficient conditions are provided un¬ 
der which £ p in (7) is input-to-state stable (ISS) with 
respect to the input Wi(t),i = {1,2}. Note that Wi{t) de¬ 
pends Xd(t ), thereby encoding the information of Fdft) 
during the contact phases. 

The following definitions, taken from [24], are required 
for the stability analysis. 

Definition 1 Consider a region Ti C 1R 2 . If z £ % im¬ 
plies cz £Ti,yc£ (0,oo) and T\{0} is connected, then 
Ti is a cone. 

Definition 2 Let z = Aiz be the dynamics on an open 
cone Ti C R 2 , i =_1 An eigenvector of At is 

visible if it lies in Ti, the closure ofTi- 

As a stepping stone towards proving ISS of (7), we 
provide sufficient conditions for the global uniform expo¬ 
nential stability (GUES) of the origin of E p when Wi = 0. 
This corresponds to studying the unperturbed system 

£“ : z = AiZ Vz £ flift). (9) 

The GUES of the origin of £“ for any Xdft ) satisfying As¬ 
sumption 1 can be concluded by considering the worst- 
case switching sequence [23,25]. In this way, we obtain 
the time-invariant system E™, defined below, with state- 
based switching, that represents the worst-case switch¬ 
ing sequence for £“ in (9). The worst-case switching se¬ 
quence is defined as the switching sequence that results 
in the slowest convergence (or fastest divergence) of the 


solution of E 11 towards (or from) the origin. Denote with 
oft) : R —► {1, 2} the switching sequence corresponding 
to i £ {1, 2} in (9). Note that oft) depends on the initial 
condition zfto) = ~o- Then, the solution of £“ starting 
from zq at to will be denoted by zft) = <F u (t, to; o)zq, 
with $„(t, to',o) the state transition matrix associated 
with the switching sequence oft). For K 2 > K\, repre¬ 
senting a manipulator interacting with a stiff environ¬ 
ment, the worst-case dynamical system T, w , associated 
with the worst-case switching sequence, is characterized 
by the following lemma. 

Lemma 1 Consider the switched system 

T, w : i = A,z, Vz £ 5,, (10) 

with A\ and A 2 as in (7). Assume K 2 > K\ and let 

5 1 = {z£ R 2 |z 2 ((A' 1 - K 2 )zi + (Ri - B 2 )z 2 ) < 0}, 

5 2 = {z£ R 2 |z 2 ((A'i - K 2 )zi + (Si - B 2 )z 2 ) > 0}. 

For the solution of £“ in (9) corresponding to an ar¬ 
bitrary switching signal oft) and initial condition zq, 
!!$„(*,t 0 ; o)z 0 1| < ||$«,(Mo)zo|| fort > t 0 , where$ w de¬ 
notes the state transition matrix ofYT in (10). In this 
sense, we will refer to $ w (t,to)zo, t > to, as the worst- 
case response ofT, u with initial condition zo- 
Proof: Let z = A a ^z denote the time-varying vector 
field associated with the switching signal oft) £ {1, 2} Vt 
corresponding to an arbitrary Xdft) satisfying Assump¬ 
tion 1. Let V = - : z T z be a positive definite comparison 
function, with time derivative V = z T z = z T A cr n\z. Let 
us define V) := z T AiZ for i = {1, 2}. Then it holds that 
V = z T A a ( t ' j z < max^Vi,U 2 )- From the structure of 

Ai and A 2 in (7), with K 2 > K\ ■ it follows that V} > V 2 
if Z 2 {{Ki~ Ar 2 )zi + (i?i — B 2 )z 2 ) < 0 and vice versa, such 
that a switching logic based ont = argma Xj e ^ 12 yVj, is 
equivalent with the one in (10). For equal initial condi¬ 
tions zo, it follows that V($ u (t,to',o)) < V($ w (t, to))- 
Since V(z) = ^||z|| 2 , it follows that ||$ ll (f, f 0 ; cr)|| < 
||$u,(f, to)|| and E™ generates the worst-case response of 
£“. □ 

From the definition of <Si and S 2 given in Lemma 1, 
we obtain the two switching surfaces Z 2 = 0 and (K\ — 
K 2 )zi + (Bi—B 2 )z 2 = 0 that characterize the worst-case 
switching. These switching surfaces and the subsystems 
of T, w that are active between the switching surfaces are 
visualized in Figure 2 for K 2 > K\ and B 2 > B\. 

In Theorem 1 below, necessary and sufficient condi¬ 
tions for the global uniform asymptotic stability (GUAS) 
of £™ are given. We then show in Lemma 2, that GUAS 
of T, w implies GUES of E“ and this, in turn, implies ISS 
of E p w.r.t. Wi for an arbitrary Xdft) satisfying Assump¬ 
tion 1. This result is given in Theorem 2 at the end of 
this section and, together with Theorem 1, constitute the 
main result of this paper. We refer the interested reader 
to Appendix B for further details about the background 
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and 



Figure 2. Switching surfaces and domains of E“ for K% > K\ 
and B 2 > B\. The vectors Uj and v\ represent the real 
eigenvectors of Ai in (14). 


material used to obtain the following results. 

Theorem 1 Let Ki,Bi > 0, A K := K\ — K 2 < 0 and 
A B := Bi — B 2 . The origin of the unperturbed, conewise 
linear system T, w is GUAS if at least one of the following 
conditions is satisfied: 

i. T, w has a visible eigenvector associated with an eigen¬ 
value A < 0; in other words, one of the following two 
conditions is satisfied: 

(a) a visible eigenvector exists in Si, i.e., A B < 0, 

^ , AK 2 Ki 

Bf > 4K\ and —— < - = 

1 “ A B Bi- \J Bf - 4K X 

(b) a visible eigenvector exists inS 2 , i.e., Bf > 4AT 2 
and one of the following conditions is satisfied: 

, A „ A K 2 K 2 

1) A B < 0 and —— > - ; -., or 

A B b 2 + \f B 2 Z - 4K 2 

2) A B > 0. 

ii. T, w has no visible eigenvectors and AjA 2 < 1, where 
A i, i = {1, 2}, are given by: 

1) if Bf < 4 Ki, 


(11) 

with tpi := mod arctan( 2 Q iAK ),TT^, 
Q := B t AI< - 2 I< Z AB, uj, := and 

L:= V(A/v ) 2 + (AS) 2 . 

2) if Bf = 4K h 


Ai = 


B,L 


2 AK - BiAB 




2A K ' 

2Ak-b'Ab j 


■ (12) 


with X ai := 

— Bi + G B^—AKi 
Abi •— 2 

Proof: From Lemma 3 in Appendix B it follows that H w 
in ( 10 ) has no sliding modes on the switching surfaces. 
Therefore, Theorem 3 can be applied to conclude GUAS 
of the origin of E™. To this end, consider the conditions 
under points i and ii sequentially: 

i. Since Ki, Bi > 0, both A\ and A 2 are Hurwitz, such 

that 5i(A^ 2 ) < 0 , with A ^ 2 = Bt± ^^ i ~ AKl being 
the eigenvalues of Ai. An eigenvector is visible in 
Si if the eigenvalues A^ 2 of Ai are real and for at 
least one of the corresponding eigenvectors 



-Bi+^/Bf-4Ki 


-Bi-y/B?-4Ki 

v\:= 

2Ki 

5 v 2 : ~ 

2Ki 


1 


1 


(14) 


it holds that u* £ Si, with j = 1 or j = 2. These 
eigenvectors lie in the second and fourth quadrant 
of the phase portrait. For j = 1, Figure 2 shows 
the eigenvectors v\ and v\ and switching surfaces 
z 2 = 0 and z 2 = — %\ZbI z i- subsystem ac¬ 
tive in 1 S 1 has a visible eigenvector if A B < 0 
(switching surface in second and fourth quadrant) 
and the slope of the corresponding real eigenvec¬ 
tor with the steepest slope, i.e. v{, is steeper than 
z 2 = — B? Zl ’ i- e - th e inequalities of condition 
i.(a) of the theorem hold. 

Similarly, it follows that the subsystem active in 
S 2 has a visible eigenvector if either 1) A B < 0 
(switching surface in second and fourth quadrant) 
and z 2 = — jffzjff ~i has a steeper slope than the 
real eigenvector of S 2 with the least steep slope, 
i.e. vf, or 2) A B > 0 (switching surface in first 
and third quadrant, hence S 2 spans at least the 
whole second and fourth quadrant). These two cases 
hold when conditions 1) and 2) of condition i.(b) 
of the theorem are satisfied. For both cases, GUAS 
of the origin follows from case (i) of Theorem 3 in 
Appendix B. 

ii. In case no visible eigenvectors exist, case (ii) of The¬ 
orem 3, provided in Appendix B, must hold with 
A := A 2 A 2 < 1, or equivalently, AiA 2 < 1 in order 
for the origin of T, w to be GUAS. The expressions 
(11)-(13) follow from the three cases (B.1)-(B.3) of 
part (ii) of Theorem 3, with the following vectors 
and matrices 


3) if Bf > 4 Ki, 


A = 


AKX bi + KAB 


KiL 

AKX ai + KiAB 




KiL 


(13) 


P12 — 


-P12 = 


" 1 " 

1 2 1 

A B 


j P21 — P21 — T 


0 

1j 

-A K 


" ~ K i 

~Bj ' 


2 

4 

UJi 

2 UJi 

, 2 ) Pi = 

Bi TP 

0 

1 

1 

0 
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from (15) that 


3) P* 


A„i Xm, 

A'i Ki 

1 1 


□ 


This Theorem can be interpreted as follows. If the sys¬ 
tem E™ does not have a visible eigenvector (case ii), 
the response spirals around the origin and visits the re¬ 
gions and (S 2 infinitely many times. In such a case, 
the worst-case system S’" switches between free motion 
and contact, but if A < 1, defined in the proof of Theo¬ 
rem 1, the resulting bouncing behavior is asymptotically 
stable, implying that the amplitude of the oscillation de¬ 
cays over time. Furthermore, since the trajectory leaves 
each cone in finite time (see Lemma 5 in Appendix B), 
the time between two switches is fixed and finite, im¬ 
plying that Zeno behavior (infinitely many switches in 
finite time) of E“ is excluded. If T, w does have a visible 
eigenvector with A < 0 (case i), the response converges 
to the origin exponentially without leaving the cone (see 
Lemma 4 in Appendix B). Then, the system does not 
switch between free motion and contact and bouncing of 
the manipulator against the environment does not oc¬ 
cur. 


The following lemma states that GUAS of E™ implies 
GUES of £“. 


Lemma 2 IfT, w in (10) is GUAS, then the origin ofYF 
in (9) is GUES for arbitrary Xd(t) satisfying Assump¬ 
tion 1. 

Proof: By Lemma 1, ||<E> u (t, t 0 ; er)z 0 || < (Mo) A) II- 

So, if the origin of E™ is GUAS, then so is the origin of E“ 
for arbitrary Xd(t) satisfying Assumption 1. Then, from 
Theorem 2.4 of [23] it follows that the origin of E“ is 
GUES for arbitrary Xd(t) satisfying Assumption 1. □ 

From Lemma 2, £“ is GUES if T, w is GUAS, and this 
last fact is guaranteed when one of the conditions given 
in Theorem 1 holds true. The following theorem provides 
conditions for ISS of the perturbed system E p in (7). 
Theorem 2 Consider the perturbed system E p in (7), 
with piecewise-continuous, bounded input u>i(t). If the 
origin of the unperturbed system E“ in (9) is GUES for 
arbitrary Xd(t) satisfying Assumption 1, then E p is ISS 
w.r.t. Xd{t). 

Proof: For an arbitrary switching sequence er(t) : R —> 
{1,2}, resulting from arbitrary Xd{t) satisfying Assump¬ 
tion 1, the solution of E p , with initial condition zq at to, 
can be expressed as (see [26], Chapter 1) 


z(t) = $ u {t,t 0 -,<j)zo + [ $ u {t,T;a) Nwi(T)dr. (15) 
Jt 0 


If the origin of £“ is GUES, which is guaranteed if the 
conditions in Lemma 2 are satisfied, ||$„(f, to; cr)|| < 
ce —A(t— 1 °), j? or some constants c, A > 0. Then, it follows 


||z(*)|| < ||<MMo;c)A)|| + II I $ u (t,T;a)Nwi(T)dT\\ 

Jto 

Kce-^-^WzoW+c f e- x ^ ||lV Wi (r)||dr 
Jto 

<ce- x ^\\z 0 \\+^ sup ||A r Wi(r)|| . 

^ v y A to<r<t 

0(11*0 lilt—to) '---' 

7( su Pt 0 < T <t MMUII) 

Since /? is a class ICC function and 7 is a class 1C function, 
E p is ISS for arbitrary Xd{t) satisfying Assumption 1. □ 

This theorem can be interpreted as follows. If 
Nwiit ) = 0, the response of E p is equivalent to the re¬ 
sponse of £“, whose origin is GUES. Due to (5), Xd{t) 
encodes the information of F ( i (t) during the contact 
phase, so x —> Xd{t) and F e —> Fdit) exponentially. 
If Nwi(t) ^ 0, the response of E p deviates from the 
response of E u , (i.e. x and F e will only converge to 
neighbourhoods of Xd(t) and Fd(t), respectively), but 
due to the ISS property the response of E p is bounded 
and the bound on the error norm ||^||, with z defined in 

( 6 ) , will depend on the norm of the perturbation Nwi. 

4 Example with a stiff environment 

We now illustrate the use of the developed theory by 
means of simulations and show the implications of satis¬ 
fying Theorem 2 on the controller design. Consider a ma¬ 
nipulator with M = 1 kg and b = 0 Ns/m (i.e. no viscous 
friction is present in the manipulator to help dissipate 
energy), interacting with an environment with k e = 10 6 
N/m and b e = 10 Ns/m. For the control parameters we 
choose M a = 0.8 kg, k p = 4000, kd = 80, kf = 1 and 
bf = 5. For this parameter set, the eigenvectors of A 2 in 

(7) are complex, such that no visible eigenvectors exist 
in the contact phase (see Definition 2). The eigenvectors 
of Ai in (7) are real, but not visible. The response of the 
system is shown in Figure 3. Although Xd(t) and Fd{t) 
used for the simulation in Figure 3 are not necessarily 
worst-case inputs, the value A = A{A| = 10.16 indi¬ 
cates that the system is potentially unstable (the con¬ 
ditions in case ii of Theorem 1 are necessary and suf¬ 
ficient for stability of TF , since they are based on its 
exact solution). The controller tracks Xd(t) in free mo¬ 
tion, but due to the stiff environment and nonzero im¬ 
pact velocity, a large peak force occurs (see bottom plot 
in Figure 3). The manipulator bounces then back from 
the environment and breaks contact. During the 0.15 s of 
intended contact, the manipulator continues to bounce 
and is not able (see Figure 3) to track the desired con¬ 
tact force Fdit), which has a maximum of 7 N. Around 
0.27 s the motion controller is no longer able to bring 
the manipulator in contact with the environment due to 
the relatively large negative derivative term in (3a). The 
amplitude of the bouncing does decay over time, but 
Figure 3 clearly illustrates an undesired response. The 
problem is the lack of damping in contact. Increasing 
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Figure 3. Simulation results with bf = 5. The grey area 
indicates the contact phase. 



time [si 

Figure 4. Simulation results with 6/ = 9000. The grey area 
indicates the contact phase. 

the damping level in the force controller to bf = 9000 
results in A = = 0.98, such that the origin of E -1 " 

is GUAS (see Theorem 1) and the system E p is ISS, for 
any motion-force profile Xd (t) , Fd (t) satisfying Assump¬ 
tion 1 (see Theorem 2). With bf = 9000, the manipula¬ 
tor does not bounce against the environment (see Fig¬ 
ure 4) and, after the peak impact force, the contact force 
F e approximately tracks Fd(t). 

However, such a high damping gain bf in contact is 
probably not realizable in practice, so therefore we pro¬ 
pose a different solution, namely a compliant manipula¬ 
tor. The results of Theorem 2 are then used as a system¬ 
atic procedure to design the stiffness of the wrist. This 
solution is discussed in the next section. 

5 Compliant manipulator design 

This section discusses the motivation for the need of 
a compliant manipulator and shows how Theorem 2 can 
be used to tune the stiffness and damping properties of 
the introduced compliancy. 



Figure 5. Manipulator with compliant wrist. 

5.1 Motivation and design 

A drawback of the high damping gain bf used in the 
simulation in Figure 4 is that it results in a lag in track¬ 
ing Fd{t) for t £ [0.17,0.28] (sluggish response). More¬ 
over, most manipulators are not equipped with velocity 
sensors. So typically, the velocity signal x, used in (3b), 
must be obtained from the position measurements. Due 
to measurement noise, encoder quantization and a finite 
sample interval, realizing the damping force —bfi ap¬ 
pearing in (3b) is very hard, for not saying impossible, 
in practice, even if one would use a state observer to es¬ 
timate x. 

Inspired by the favorable properties of the skin around 
a human finger, we propose, as a more practical alter¬ 
native, to design the manipulator by including passive 
compliance in the connection between the arm and the 
end-effector (wrist) as sketched in Figure 5. Indicating 
with k t and b t , respectively, the stiffness and damping 
coefficient of the wrist and with Xt the position of the 
end-effector, the dynamics of the compliant manipulator 
is 

Mx + bx = F c — F t , (16a) 

M t x t = F t - F e (x t ,x t ), (16b) 

where the internal force F t is given by 

F t = k t (x - x t ) + b t {x - x t ). (17) 

The environment model and controller are still given by 
(2) and (3), respectively, and (3) controls x to Xdit). 

The compliant wrist and end-effector are designed to 
improve the response during and after the impact phase. 
So, we consider a design where the mass M t is smaller 
than M to reduce the kinetic energy of M t engaged at 
impact. The damping bt is larger than b e to help dissi¬ 
pate the impact energy and provide more damping in 
the contact phase. The stiffness k t is designed smaller 
than k e ( k e is much larger than all other parameters) to 
reduce the eigenfrequency and increase the damping ra¬ 
tio of the contact phase. In symbols, we can write these 
assumptions as 

M t -C M, k t -C k e , b t » b e , and ^-Cls. (18) 

rZ e 

5.2 Reduced order model 

The stability results of Section 3 only apply to two- 
dimensional systems. The dynamics of the 2-DOF com¬ 
pliant manipulator of (16) is 4-dimensional, so Theo¬ 
rem 1 cannot be applied directly. However, when (18) 
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is satisfied, the compliant 2-DOF manipulator (16) ex¬ 
hibits a clear separation between fast and slow dynamics. 
In free motion, the fast dynamics are related to x — Xt, 
and, in contact, to the end-effector position Xt . The time¬ 
scale of the (exponentially stable) fast dynamics is very 
small compared to the time-scale of interest, so the slow 
dynamics can be considered as the dominant dynamics 
describing the response x of the compliant manipulator 
to the control input F c (t). 

Consider the 2-DOF compliant manipulator (16), (2) 
with M ~ 10°, b ~ 10°, M t ~ 10“ 2 , k t ~ 10 4 , b t ~ 10 2 , 
k e ~ 10 6 and b e ~ 10 1 . The model reduction analysis 
in Appendix C shows that the slow time-scale response 
of this system in free motion and contact considered 
separately can be approximated by the following model 

of reduced (2 n< ^) order: 


Mx + bx = F c — F e (x, x), 


(19) 


F e (x,x) 


0 for x < 0 

b e x + k e x for x > 0 


( 20 ) 


with b e := bt k and k e := kt k ^f k ■ The fraction 
~ 1 for k t -C k e , so kt and b t directly influence 
the perceived environment damping and stiffness by the 
mass M. 

The reduced-order dynamics (19), (20) are obtained 
separately for the free motion and contact case. During 
free motion to contact transitions, the high-frequency 
dynamics of (16), (2), which are not captured in (19), 
(20), might still be excited. However, the simulations 
provided in Section 5.4 indicate that the response of (19), 
(20) accurately approximates the response of (16), (2), 
subject to (18) and controlled by (3). Hence, we claim 
that the reduced-order model (19), (20) can be used to 
analyze stability of (16), (2), in closed loop with (3). 


5.3 Stability of the reduced-order model 

Since the reduced-order model (19), (20) has exactly 
the same structure as (1), (2), we can employ the stabil¬ 
ity analysis as in Section 3 to design the parameters of 
the controller in (3). In contact, we use a similar expres¬ 
sion to relate Fd{t) to Xd{t ), namely 


F d (t) = k e x d (t) + b e x d {t)+Wf(t), for F d (t) > 0 (21) 


withu>/(t) := (k e —k e )xd(t)+(b e —b e )xd(t), and k e and b e 
available estimates of k e and b e , respectively. The design 
of the desired trajectories such that Xd(t) is bounded 
and twice differentiable is discussed in Appendix A. 

The system described by (19), (20), (3) and (21) can 
be expressed in the form of (7), with (8a), (8c), (8d) 
and 


K 2 := 


(1 + kf)k e 


B 2 := 


(1 + kf)b e + bf + b 


( 22 ) 



time [s] 


Figure 6. Simulation results of compliant manipulator de¬ 
scribed by (16). The grey area indicates the contact phase. 

As a result, ISS can be concluded from Theorem 2 for ar¬ 
bitrary Xd (i) satisfying Assumption 1 if the conditions of 
Theorem 1 are satisfied. Compared to the system with¬ 
out compliant wrist, we now have more flexibility to tune 
the parameters for stability and performance. From The¬ 
orem 1 we can compute the required values of the design 
parameters k t and b t to meet design specifications such 
as the existence of a visible eigenvector corresponding to 
a stable eigenvalue (implying bounceless impact) or an 
upper bound on A = A 2 A 2 in Theorem 1. In case of a 
visible eigenvector corresponding to a stable eigenvalue, 
stable contact with the environment without bouncing 
can be achieved for all bounded signals Xd(t), Fd(t). 

5-4 Compliant manipulator example 

The following example illustrates how to design the 
compliant wrist parameters Mt, b t and kt to improve 
the closed-loop performance compared to the simulation 
results of Figure 3. For the design of the end-effector, 
consider M t = 0.05 kg and k t = 5 ■ 10 4 N/m (k t -C 
k e , but still large to minimize the spring-travel in the 
wrist). With bf = 5 Ns/m, we require bt > 170 Ns/rn to 
guarantee that A < 1, such that one of the conditions of 
Theorem 1 is satisfied. Figure 6 shows the response of the 
unreduced compliant system (16), (3) and (2), with b t = 
171 Ns/m. Compared to Figure 3, the peak impact force 
is reduced. During the first 20 ms of intended contact, the 
tip makes and breaks contact due to the fast dynamics 
of (16). After 20 ms the fast dynamics of (16) damp out, 
the slow dynamics become dominant and the response 
of (16) converges to that of (19). Hence, F e tracks the 
desired trajectory F ( j{t) (without a sluggish response as 
in Figure 4). Since stability is now obtained with a (more 
practical) passive implementation, there is more freedom 
in tuning the parameters of the controller in (3). 

Finally, Figure 7 shows a comparison of the response of 
the 4-dimensional compliant manipulator described by 
(16), (17), (2), controlled by (3), and the 2-dimensional 
model described by (19), (20), and controlled by (3). 
The peak impact force of the 2-dimensional model is 30 
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time [s] 

Figure 7. Simulation results of the compliant manipulator de¬ 
scribed by (16), (17), (2) (black line), and the reduced-order 
model described by (19), (20) (blue line). The grey area in¬ 
dicates the contact phase, i.e. xt > 0 for the 4-dimensional 
model (16), (17), (2) and x > 0 for the 2-dimensional model 
(19), (20). 


percent smaller, but the time of making and breaking 
contact is almost equal. The main difference between the 
two models is found between 0.155 s and 0.18 s, where 
the fast dynamics of the 4-dimensional model are excited 
due to bouncing of the tip against the environment. Here, 
the 2-dimensional model has a second peak around 0.16 
s due to a larger impact velocity compared to the tip 
of the 4-dimensional model. After 0.18 s, the response 
of both models is similar, indicating that (19), (20) is 
indeed a good (slow time-scale) approximation of (16), 
(17), (2) and that Theorem 1 can be used as a guideline 
for the design of damping and stiffness parameters of the 
compliant wrist and of the switching controller (3). 

5.5 Discussion 

From the expressions k e and b e in (20) and the results 
in Figure 6, we see that the compliance in the manipula¬ 
tor can contribute to guaranteeing stability and improve 
the tracking performance during free motion to contact 
transitions. In fact, with b t b e , the end-effector acts 
as a vibration-absorber, dissipating the kinetic energy 
present at impact. And due to the compliance, we can 
lower the stiffness and increase the damping of the per¬ 
ceived manipulator-environment connection in contact. 
As a result, the controllers (3a) and (3b) can be tuned 
separately for optimal performance in free motion and 
contact, respectively, rather than a trade-off to guaran¬ 
tee stability during transitions in case of a rigid manip¬ 
ulator. Using a light end-effector and tuning of bt and 
k t to satisfy Theorem 1, stable contact with the envi¬ 
ronment can be made for arbitrary Xd(t) and Fd(t) sat¬ 
isfying Assumption 1. Moreover, if a visible eigenvector 
exists in the contact phase, even bouncing of the manip¬ 
ulator can be prevented for arbitrary Xd(t) and Fd(t). 


6 Conclusion 

We consider the position-force control of a manipu¬ 
lator in contact with a stiff environment, focusing on 
a single direction of contact interaction. We propose a 
novel switching controller that, when tuned properly, en¬ 
sures stable bounded tracking of time-varying motion 
and force profiles. Moreover, we provide sufficient condi¬ 
tions for the input-to-state stability (ISS) of the closed- 
loop tracking error dynamics with respect to perturba¬ 
tions. The stability analysis that we introduce in this 
paper shows that for realistic parameter values, a high 
level of controller damping is required during contact to 
guarantee stability of the closed-loop system. Such high- 
gain velocity feedback is undesirable for achieving satis¬ 
fying tracking performance and, moreover, likely unre¬ 
alizable in practice. Based on the results of our investi¬ 
gation, we propose to combine the proposed switching 
controller with a mechanical design of the manipulator 
that includes a compliant wrist. The stability conditions 
presented in Theorems 1 and 2 can be used as a guideline 
for the design of the damping and stiffness of this com¬ 
pliant wrist as well as the control parameters to guar¬ 
antee stability. Furthermore, by designing the closed- 
loop response to possess visible eigenvectors, those sta¬ 
bility conditions can be used to shape the closed-loop 
response to prevent persistent bouncing of the manipu¬ 
lator against the environment for arbitrary desired mo¬ 
tion and force profiles. 
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Appendix 

A Design of continuous signals x d {t) and x d (t) 

In this appendix, we present a method to obtain 

continuous signals x d (t) and x d (t) (and corresponding 



Figure A.l. Example of a construction of x d (t) and F d (t) 
from Xd(t) and F d (t). 

F d (t )), required as reference signals for the switched 
controller (3), from the continuous and bounded refer¬ 
ence profiles x d (t) and F d (t) specified by the user. 

Denote the i th intended time of making contact by 
4 ,» and the subsequent time of breaking contact by t(,,» 
respectively, as indicated in Figure A.l. Then, during 
the contact time interval [4,ii4,*]> F d (t) and x d (t) are 
obtained from 

m = - 2712/1 - 7i ( 2/1 - Fd{t)), (A.la) 

yi(fc,i) — k e X d {tc,i') F b e X d (t c ,i )5 
2/1 (4,i) — keX d {fc,i) F b e X d (t Cj i'), 

k 1 

2/2 = ~A'h + j^yi) 2/2 (4,i) = x d (t Cii ), (A.lb) 
be b e 

2/2(4,i) — X d {fc,i) 

with the outputs F d {t) = yi, x d (t) = 1/2 and x d (t) = ij 2 
for t £ [4,i;4y]- The 1 / 2 -dynamics follow from the time 
derivative of (4) and guarantee continuity of x d [t) and 
x d (t) at t = 4,+ The j/i-dynamics represent a critically 
damped second-order filter on F d (t) to guarantee conti¬ 
nuity of F d (t) and F d {t) at t = 4,+ As a guideline, the 
time constant 71 > 0 in (A.la) is chosen such that the 
’bandwidth’ of this filter is significantly higher than the 
frequencies present in F d (t). 

Continuity of the profiles x d (t) and x d (t) when break¬ 
ing contact is guaranteed when these profiles during the 
free motion time interval [t&,*> 4 ,»+ 1 ] are obtained from 
x d (t) filtered by the critically damped second-order filter 

2/3 = - 2722/3 - 72 ( 2/3 - x d (t)), y 3 {tb,i) = x d (h,i), (A.2) 

2/3(4,j) = Xd{tb,i), 

with outputs x d (t) = 2/3 an d x d (t) = y 3 for t £ 
[4,i, 4 , 2 + 1 ]• As for 71 in (A.la), the time constant 72 > 0 
in (A.2) is chosen such that the ’bandwidth’ of (A.2) 
is significantly higher than the frequencies typically 
present in x d (t). 

B GUAS of a conewise linear system 

The stability results presented here are based on the 
results presented in [24] and ultimately lead to the state¬ 
ment of Theorem 3, which is used in the proof of The¬ 
orem 1 in the main text of this paper. The results in 
[24] apply to continuous , conewise linear systems. The 
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conewise linear system E™ in ( 10 ) is, however, discon¬ 
tinuous. The continuity of the vector field is required in 
[24] to exclude the existence of unstable sliding modes at 
the switching surfaces of the conewise linear system. The 
following lemma shows that S w has no sliding modes at 
the switching surfaces. 

Lemma 3 For K\ — K 2 < 0 , the conewise linear system 
T, w has no sliding mode. 

Proof: The existence of a sliding mode at the two switch¬ 
ing surfaces Z 2 = 0 and Z 2 = — ~i °f are con ~ 

sidered sequentially: 

• Consider the subspace {z £ R 2 |, 2 i > 0}. The normal 
Afi to the switching surface Z 2 = 0 is given by A/] = 
[0,1] T . The inner product of the vector fields AiZ, i £ 
{ 1 , 2 }, with A/) at the switching surface Z 2 = 0 reads 
XNiA.jVi = —\Ki , where Vi = [1,0] T and A > 0. 
This inner product has the same sign for both vector 
fields associated with i = 1 and i = 2 , such that no 
sliding mode exists at the switching surface Z 2 = 0 , 
see e.g. [27]. 

• Consider the subspace {z £ R 2 |zi > 0}. The normal 

A /2 to the switching surface Z 2 = — z i is given 

by M 2 = i [A K, AP] T , with A K := K { - K 2 , A B := 
Bi — f ?2 and L := -^/(A K) 2 + (A B) 2 . The projection 
of the vector fields AiZ, i £ { 1 , 2 }, with A /2 at the 
switching surface z 2 = read 

AA/iT A 1 V 2 = ^((AA ) 2 + Ki(AB) 2 - B 1 {AK)(AB)), 
AA/? A 2 v 2 = A((a K) 2 + K 2 (AB) 2 - B 2 (AK)(AB)), 



Figure B.l. Example of a trajectory of (10) that traverses 
each cone once per rotation. 

tion, as indicated in Figure B.l. Stability for a spiraling 
motion can be analyzed by the computation of a return 
map. Suppose the trajectory of (10) enters a region Si at 
ti-i at position z(U-i), which is located on the bound¬ 
ary E t _ii between cones Si -1 and Si, such that z(U- 1 ) 
can be expressed as z{ti- 1 ) = Here, p l repre¬ 

sents the radial distance from the origin at time A_i and 
Pi-i,i is the unit vector parallel to the boundary Ei-i,i. 
The trajectory crosses the next boundary £}.i + i at fi¬ 
nite time ti (Lemma 5), and the position of this crossing 
is given by z(U) = p i+ 1 PM+i> such that z{U) is parallel 
to pi.i+i- Since the dynamics in each cone are linear, the 
time ti can be computed explicitly. The crossing posi¬ 
tions are linear in p 1 , so expressions for a scalar A,, such 
that p l+1 = A ip 1 , can be obtained. 

In order to construct the return map, consider for each 
cone the following coordinate transformation 


where v 2 = j; [—A B, A K] T and A > 0. It can be shown 
that AAA 2 T A-\ U '2 — \N?A 2 V 2 = 0 , > 0 , hence, 

the inner products XJ\f 2 Ajv 2 and XAf 2 A 2 V 2 have the 
same sign, such that no sliding mode exists on the 
switching surface z 2 = — z i; see e -g- [27]. 

With a similar analysis, the same results can be obtained 
for the subspace {z £ EL 2 | 2 ri < 0 }. □ 

The following lemma holds for continuous conewise 
linear systems Yi w with visible eigenvectors. 

Lemma 4 ([24]) Consider a continuous, conewise lin¬ 
ear system of the form S’". When this system contains 
one or more visible eigenvectors, then z = 0 is an asymp¬ 
totically stable equilibrium ofT, w if and only if all visible 
eigenvectors correspond to eigenvalues A < 0. 

This lemma can also be shown to be valid for discon¬ 
tinuous conewise systems S’" in the absence of a sliding 
mode. The following lemma is useful in the analysis of 
the behavior of E™ in the absence of visible eigenvectors. 
Lemma 5 ([24]) Let Si be a closed cone in 1R 2 . Suppose 
no eigenvectors of Ai £ R 2x2 are visible in Si. Then for 
any initial condition zo £ Si, with zq ^ 0 , there exists a 
time t > 0 such that e Ait zo ^ Si. 

If Lemma 5 holds for all cones, the trajectories exhibit a 
spiralling response, visiting each region i once per rota- 


? = Pr x z, for z i £ Si := {z l £ R 2 | 5 i = P~ 1 z \ z £ SJ, 

where Pi is given by the real Jordan decomposition of Ai, 
yielding Ai = PiJiP~ x . Depending on the eigenvalues 
of Ai, three different cases can be distinguished. 

( 1 ) Ai has complex eigenvalues denoted by a,; ± uj-i, 
where ai and uJi are real constants and w, > 0 . 
Then, Ji = [ “* ]. Define (j)(ri, r 2 ) to be the an¬ 

gle in counter clockwise direction from vector r\ to 
vector r 2 . Then, 


Ai = 


II A-l,ill £r0(p*-i.i 

IIpUiII 


Pi,i +lJ 


(B.l) 


with p|_ M := Pi 1 Pi-i,i and p\ i+l := P, 1 p i , i+ i 
( 2 ) Ai has two equal real eigenvalues A a i with geometric 
multiplicity 1. Then, Ji = [ 0 \ ai ] anc ^ 


A i = 


pT ni 

e 2 Pi-1,i 

p T -zi 

e 2 Pi,i+1 



(B.2) 


where ei := [ 1 , 0 ] T and e 2 := [ 0 , 1 ] T . 
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(3) Ai has two distinct real eigenvalues A a i and \u- 
Then, Ji = [ A °. ] and 



\bi-\ai 


e 2 Pi,*+1 


e l Pi,*+1 

e T T.% 
e 2 Hi-1,i 


pT 7.1 

e i Hi-i,i 


From the scalars A,; for each cone Si,i = 1 ,,m, the re¬ 
turn map between the positions Zk and Zk+i of two con¬ 
secutive crossings of the trajectory z(t) with the bound¬ 
ary E m i can be computed as Zk+ i = A Zk, where 

m 

A=nA.. 

i = 1 

Theorem 3 below is an extension of Theorem 6 in 
[24] and provides necessary and sufficient conditions for 
GUAS of the origin of the discontinuous, conewise linear 
system T, w . 

Theorem 3 Under the assumption that no sliding 
modes exist, the origin of the discontinuous, conewise 
linear system T, w in (10) is GUAS if at least one of the 
following conditions is satisfied: 

(i) In each cone Si, i = 1,..., m, all visible eigenvectors 
are associated with eigenvalues A < 0. 

(ii) In case there exists no visible eigenvector, it holds 
that A < 1. 

Proof: If no sliding modes exist on the switching sur¬ 
faces, GUAS of the origin of the discontinuous system 
H w can be proven similarly to the proof of Theorem 6 in 
[24] for continuous, conewise linear systems. □ 

From Lemma 3 it follows that T, w in (10) has no slid¬ 
ing modes on the switching surfaces, so Theorem 3 can 
indeed be applied to conclude GUAS of the origin of E 1 ". 

C Model reduction compliant manipulator 

The model (19)-(20) describes the slow dynamics of 
(16), (17), (2) and is obtained by employing Theorem 
11.2 of [28]. With this theorem, the slow dynamics are 
obtained for an infinite time horizon t. £ [<o,oo]. We 
will refer to it as Tikhonov’s extended theorem, since the 
original theorem of Tikhonov, see e.g. Chapter 7 of [29], 
only applies on a finite time horizon t £ [to,tf]. 

Tikhonov’s extended theorem is applicable to systems 
described by (non)linear continuous, possibly time vary¬ 
ing, dynamics. The dynamics of (16), (17), (2) are not 
continuous due to the switch between free motion and 
contact. Therefore, we consider the model reduction of 
the free motion (x t < 0 ) and contact (x t > 0 ) phases 
separately. The simulation results presented in Section 5 
indicate that for the considered parameter values the re¬ 
sponse of the original compliant manipulator dynamics 
(16), (17), (2), including the transitions between free 
motion and contact, can be approximated by the dy¬ 
namics of the reduced-order model (19)-(20). 

Below, for both free motion and contact, the reduction 
of the d^-order model (16), (17), (2) to the second-order 


model (19)-(20) is performed in two steps, where in each 
step the model is reduced with one order. 

Free motion: Consider the following states 

e := x — Xt 
e := x — Xt- 

The following parameters are used as an example to illus¬ 
trate the separation of the two distinct time-scales of the 
system described by (16), (17), (2): M ~ 10°, b ~ 10°, 
M t ~ 10 -2 , k t ~ 10 4 , b t ~ 10 2 , k e ~ 10 6 and b e ~ 10 1 ! 
For these parameter values, the dynamics (16), (17), (2) 
in free motion can be written as 



~io° ~io° ~io 4 ~io 2 


_ Ml _g =_ Ml _ p (t) — e — — e 

(1 + M t /M)kt M{ 1 + M t /M)kt cV 1 k t 

'- „ -- ----' 

~ 10“ 6 ~ 10“ 6 ~ 10“ 2 

M t b 

M( 1 + M t /M)kt X ' 

'-V-' 

~io - 6 

npfinp II, •— Mt ~ _ Ml _ ~ _ Mtb 

e e FI •— (l+M t /M)kt ~ M(L+M t /M)k t ~ M(l+Mt/M)fe t 

and p 2 := p-- With these parameters, it follows that 
pi P 2 , and we obtain the following dynamics 

x = jj{F c (t ) — bx — k t e - b t e) (C.2a) 

pie = piF c (t) — p\x — e — p 2 e. (C.2b) 

Note that x does not appear directly in the right-hand 
side of (C.2). Therefore, the dynamics of (C.2) are de¬ 
scribed by the three states (x, e, e) only. 

In the analysis that follows, we consider p\ and p 2 
as singular perturbations and use Tikhonov’s extended 
theorem twice (once for p\ and once for P 2 ) to obtain a 
model of reduced order. 

Before proceeding, we first decouple the free response 
of (C.2) from the forced response (due to F c (t)). To this 
end, consider the coordinate transformation x := x — 
XF c {t), where XF„{t ) is defined as the forced response of 
the slow dynamics of (C.2) (i.e. for pi = p 2 = 0) to the 
continuous and bounded input F c (t), such that 

Mx Fc (t) + bx Fc (t ) = F c (t). (C.3) 

Note that x Fc ( t ) and x Fc (t) are continuous and bounded 
since F c (t ) is continuous and bounded. By employing 
(C.3), the unforced dynamics of (C.2) can be expressed 
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as 


x = — (-frr - he - b t e) 

Hie = HiFcit) - m(x + x Fc (t)) - e - y 2 e. 


(C. 4 a) 

(C. 4 b) 


From the conditions above, Tikhonov’s extended theo¬ 
rem allows us to conclude that for all to > 0, initial con¬ 
ditions yo G D y , (o G := R, and sufficiently small 
0 < ,Lti < Hit the singular perturbation problem of (C. 5 ) 
has a unique solution y(t, y i), £(t,/xi) on [to,oo), and 


Since yi is much smaller than all other parameters, we 
treat it as the vanishing perturbation parameter and 
use Tikhonov’s extended theorem to obtain a model of 
reduced order that describes the slow dynamics of this 
system. Consider y = [j/i, 5 2 ] T := [x, e] T as the states of 
the slow dynamics fi{y,() and ( := e as the state of the 
fast dynamics 51 (f, y , f, y\) of (C. 4 ) according to 


Vi 

_V2 

Hit = Hi F c(t) - Hi(Vi + x Fc {t)) - 2/2 - H 2 C 

=■ 9i(t,y,(,Hi)- (C. 5 b) 

For y,i = 0 , C = h\{y) := — 7^2/2 is the solution of 

0 = gi(t, 2/, C, 0 ) for y G D y = R 2 and vi := ( — 
hi(y) G D v 1 = R. Let us analyze the three conditions of 
Tikhonov’s extended theorem sequentially: 

Cl. The functions fi, g 1, their first partial derivatives 
with respect to {y,CiHi)i and the first partial 
derivative of <71 with respect to t are continuous 
and bounded on any compact subset D y x D v 1, 
since F c {t) is continuous and bounded. Further¬ 
more, h\(y) and [dgi{t, y, (, 0)/d£] have bounded 
first partial derivatives and [<9/1(5, hi{t, 5), 0 )/dy] 
is Lipschitz in y. 

C 2 . The slow dynamics of (C. 5 ) 


I?(-fa/i - hV2 - btO 

c 


=■ fi(y,0 (C. 5 a) 


fi{y>hi(y)) = 

it(-byi - hy2 + 

-2/2)" 

M 2 


_ b_ bt _ kt_ 

M M 


Vi 



1 

O 


yi. 



(C. 6 ) 


y(t,Hi) - y{t) = o{h 1 ) 

C (t, Hi) ~ hi{y(t)) - Viit/Hi) = 0 {h 1) 

holds uniformly for t £ [to, 00), with initial time t 0, 
where y(t) and 'Oi(t) are the solutions of (C. 6 ) and (C. 7 ), 
with y(t 0 ) =y(to) and vi(t 0 ) = C(*o) + 7772/2(^0) respec¬ 
tively. Moreover, given any tb > to, there is < Hi 
such that 


(i(t,Hi) - hi(y(t)) = O(hi) 

holds uniformly for t £ [4,00) whenever /ii < y\*. 
Hence, on the domain t £ [f&, 00), (C. 5 ) can be approx¬ 
imated by (C.6). Rewriting the reduced-order model 
(C.6) as the time-invariant system 

in = -jjhbyi - k tV2 + — 2/2) ■= h(yi,y 2 ,H 2 .) (C. 8 a) 
H2V2 = -2/2 := 92(2/2, M2), (C. 8 b) 

it becomes clear that H2 = 77 ~ 10 -2 is much smaller 
than all other parameters in (C.8). Hence, we can apply 
Tikhonov’s extended theorem once more with y , 2 con¬ 
sidered as the singular perturbation parameter, 2/1 the 
slow dynamics and 2/2 the fast dynamics. 

The details regarding the reduction step with /r 2 con¬ 
sidered as the singular perturbation is performed in a 
similar fashion as the first reduction step and is therefore 
omitted here for the sake of brevity. With 2/2 = h 2 (yi) := 
0 the solution of 0 = 52(2/2, 0 ), the following globally ex¬ 
ponentially stable slow dynamics of (C. 8 ) are obtained 

in = /2(2/i, h 2 {yi), 0 ) = —-^-2/1- (C. 9 ) 


have a globally exponentially stable equilibrium 
point y = 0, since -j-j and —77, representing 
the eigenvalues of the system matrix of the linear 
dynamics in (C.6), are both negative. 

C 3 . With Hi^st = 777 (i.e. r i := 77^) the (linear) 
boundary-layer system 

dv 1 

= gi(t,y,vi + hi(y), 0 ) = -2/2 - H 2 {vi -2/2) 

OTl y 2 

= -H2V1 (C. 7 ) 

has a globally exponentially stable equilibrium 
point at the origin (since /i 2 > 0), uniformly in 
(t, y) with region of attraction TZ v i = D v 1 = R. 


With V2 '■= 2/2 — h 2 {yi) and r 2 := -Ft, the boundary- 
layer system = 52(2/1, v 2 + h 2 {yi), 0 ) = -v 2 is glob¬ 
ally exponentially stable. Hence, the three conditions 
of Tikhonov’s extended theorem are satisfied, such that 
it can be concluded that (C. 9 ) is an approximation of 
(C. 8 ). After reversing the coordinate transformation, i.e. 
2/i = x — x Fc (t), and using (C. 3 ), we obtain 

Mx+bx = F c (t) (C. 10 ) 

as the approximation of ( 16 ) in free motion. 

Contact: Similar as for the free motion case, the model 
reduction for the contact case is performed in two steps. 
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Due to the relatively high environmental contact stiff¬ 
ness k e in (16), it is expected that Xt (and time deriva¬ 
tives) is approximately equal to zero (the nominal po¬ 
sition of the environment). Therefore, the motion Xt of 
the tip can be considered as the fast dynamics, and the 
motion x of the manipulator can be considered as the 
slow dynamics. The dynamics (16), (17), (2) for x t > 0 
can be rewritten as 


1 r, /.n (b+bt) b t . k t , n 

X — —— r c (t) -—- X + — Xt — — (x — Xt) 

M w M M M K ’ 


- 10 ° 


-io 2 


- 10 2 


- 10 4 


(C.lla) 


kt bt bt + b e 

AD x t = - — —f-x+ T — -f-x-Xt-- —— —x t , 


k t +k e kt + k e 


-io- 


-io- 


-io- 


kt + k e ' 

~ 10“ 4 

(C.llb) 


use Tikhonov’s extended theorem to obtain a model of 
reduced order. 

The details regarding the reduction step with singu¬ 
lar perturbation parameter fi 3 follows similar to the re¬ 
duction step for the free motion case with considered 
as the singular perturbation parameter and is therefore 
omitted for the sake of brevity. With 

Ci = 7 — 7 - 7 - (ktyi + b t y 2 - (k t + k e )y 3 ) =: h 3 (y) 

Ot + O e 

the solution of 0 = g 3 (t,y, Ci,0), the following globally 
exponentially stable slow dynamics of (C.15) are ob¬ 
tained 

y = h(y,h 3 (y)) 

V2 


where y 3 := k M + k . Consider the coordinate transforma¬ 
tion 

yi :=x-x Fc (t), 

2/2 := x - x Fc (t), Ci : = x t - x t , Fc (t), (C.12) 

y 3 := x t - x t ,F c (t), 


^ ( - (i + Mw + _h. 


(k t yi + b t y 2 


- (kt + k e )y 3 ) - k t yi + k t y 3 ) 


(C.16) 


7 —— 7 - (hyi + b t y 2 - (h + k e )y 3 ) 

Ot ~r O e 


such that y = [ 3 / 1 , y 2l y 3 ] T = 0 and Ci = 0 is the equilib¬ 
rium of (C.ll) in the new coordinates. In (C.12), Xt,F c (t ) 
and x f c (t) are defined as the forced response of (C.ll) 
for y ,3 = 0, to the continuous and bounded input F c (t), 

i.e. 


%t,F c (t ) = j —(ktx Fc (t)+b t x Fc (t)-(kt+k e )xt iFc (t)j, 

(C.13) 

Mx Fc (t) + (b + b t )x Fc (t) - b t x t ,F c (t) 

+ k t (x Fc (t) - x t ,F c (t)) = F c (t). (C.14) 


Using the coordinate transformation (C.12) and the ex¬ 
pressions (C.13) and (C.14), (C.ll) can be rewritten as 


in 


2/2 

2/2 

= 

jf(~(b + bt) 1/2 + 6 *Ci - k t (yi - y 3 )) 



.Cl 


=--h(y,Ci) (C.15a) 

AdCi = + k [ktyi + b t y 2 - (kt + k e )y 3 

~(bt + b e ) Ci) -AD &t, Fc (t) 

= : 53^,2/, Ci,AD)- (C.15b) 


With v 3 := Ci - h 3 (y) € D v3 = R and AD^f = (i.e. 

73 := the boundary-layer system 

dv 3 u , u r \ ^ b t + b e 

7 — = 93(t,y,v 3 + h 3 (y),0) = -- ——n 3 
ot 3 k t + k e 

is globally exponentially stable, and the conditions of 
Tikhonov’s extended theorem are satisfied, such that it 
can be concluded that (C.16) is an approximation of 
(C.15). Using (C.13), (C.14) and inverting the coordi¬ 
nate transformation (C.12), the (intermediate) slow dy¬ 
namics (C.16) can be written in the original coordinates 
as 


Mx = F c (t) — (b + b t )x — k t x + k t x t 

+ , bt , (hx + b t x - (k t + fc e )a; t )(C.17a) 

bt + be 

(b t + b e )x t = k t x + b t x - (k t + k e )x t . (C.17b) 

This third-order system is further approximated to a sys¬ 
tem of order 2 by considering /Z 4 := as a singular 

perturbation parameter. To this end, consider the state 
transformation 

yi~x- r(t), 

y 2 :=x- r(t), (C.18) 

C 2 := (kt + k e )(x t - r t (t)), 


Since y, 3 is much smaller than all other parameters, see such that y = [j/i, y 2 ] T = 0 and C 2 = 0 is the equilibrium 

(C.llb), we treat it as the vanishing perturbation and of (C.17) in the new coordinates. Here, ft(t) is defined 
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as the forced response of the fast dynamics of (C.17) for 
/i 4 = 0, and f(t) is defined as the forced response of the 
slow dynamics of (C.17) to the input F c (t ), with y 4 = 0, 

i.e. 

n{t) = k t f(t) + b t r(t) (C.19) 

Mf{t) + (b + b t k " )r(t) + k t f(t) = F c (t). 

rZt 1 rCg Kt 1 Ke 

(C. 20 ) 

Rewriting (C.17) in terms of the coordinates y 1 , yn and 
( 2 , given in (C.18), and using (C.19), (C.20), we obtain 


Finally, by combining the results (C.10) and (C.23), 
for free motion and contact, we obtain the model of re¬ 
duced order described by (19)-(20). 


m 


V2 

V2 

= 

m ( ( & + b t)y 2 ktyi + fct+ * fce C2 



[ + b t +b e + b *y 2 C2)) J 


=:/ 4 (y, C 2 ) (C. 21 a) 

C 2 = Jct^yi +^y 2 - (2- ft{t) 

•UO -4 ~10 4 ~10 2 ~10 -4 

:= g 4 {t,y,( 2 ,ix 4 )- (C.21b) 


Since /r 4 is small compared to the other parameters, it 
is considered a singular perturbation parameter for the 
system (C.21) and Tikhonov’s extended theorem is used 
once more to obtain a model of reduced order. Again, 
the proof of the reduction step with /i 4 considered as 
the singular perturbation follows similar to the previous 
reduction steps and is therefore omitted. 

For fi 4 = 0, (2 = kty 1 + bty 2 '■= h 4 {y) is the root 
of 0 = < 74 (i, y , £ 2 , 0 ) and the following slow dynamics of 
(C.21) are obtained 


y = h{y,hi(y)) 


V2 


®(-C 


-)y2 - kt 




k t + k, 


-y U 


(C.22) 


With v 4 := C 2 - h 4 (y) £ D v4 = E and (i.e. 

74 := ^t), the boundary-layer system = g 4 (t, y, v 4 + 
h 4 (y), 0) = — v 4 is globally exponentially stable, and the 
conditions of Tikhonov’s extended theorem are satisfied, 
such that the theorem allows us to conclude that (C.22) 
is an approximation of (C.21). Using the inverse of the 
coordinate transformation (C.18), we obtain 


M(x—r(t)) = -k t ^ ^ (x-r(t))-(b+b t ^ ^ ^ ){x-r(t)). 

Using (C.20), the slow dynamics of (C.17) (and thus of 
(C.ll)) are given by 

k k 

Mx + bx = FJt) — k t - — ’--—x—bt- — -r—x. (C.23) 

kt + k e kt + k e 
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